.DO External 

.LSTON 

.Paqe 



> > > > > 

> 
> 
> 

> 
> 
> 



>>>>>>>>>>>>>>>>>>> 



Module: Servo 



This module contains all the specifications and source code for 
controlling, the Widget Servo Board < i.e., communication 
protocol, seek and head positioning, spare table lookup, etc. > 



PROCEDURE OverLapC Response : BYTE { !rfl > 
CommandType 
B I ockType : 
B I ockNumber 
Random 
Offset 



BVTE { !r8 > 

3 BVTES { !rC:E > 
BOOLEAN { !r?/Bit 7 } 
3 BITS { !r?/Bits 2:0 > 



> 



) 

>>>>>>>>>>>>>>>>>>> 

.LSTOFF 

.FIN 

.DO External 

.LSTON 

.Page 
>>>>>>>>>>>>>> > >>>>>■>>>>>>>>>>>> 
> 

> Function: OverLap { OverLapped Seek } 

y. 

> This function allows the drive to begin a seek operation 

> < if one is needed > before getting tied up with the SOS 

> dr i ver . 



Inputs: 



Response 
CommandType 
B I ockType 
B i ockNumber 
Random 
Offset 



BVTE { !rft } 

BVTE { !r9 > 

BVTE { !rS > 

3 BVTES { !rC:E > 

BOOLEAN f Ir7/bit 7 > 

3 BITS { fr-7/bit 2:0 > 



Outputs: 



Loca I War i ab I es 
Retry 



B lockS tatus : BVTE { irO } 
BVTE { !r4 > 



Algorithm: 

BEGIN 
IF < Srch_Cache< B I ockNumber, Random > > 
THEN 
IF ( SrchJCache.Head <> Head > 
THEN 

SelectHead< Srch_£ache . Head ) 
Head := Srch JCache . Head 
Sector := SrchJCache. Sector 
ftckJtead 
ELSE 
Retry := 4 
Temp := False 
REPEAT 



> Retry := Retry - 1 

> Temp := Posi tionHeads< NoUait, DmtJDverLap, BiockNumber ) 
> 

> UNTIL NOT< Recovery ) OR Temp OR ( Retry = ) 
> 

> IF H0T< Temp > THEH Abort 

> Bloc-kS tat us := Posi tionHeads.Status 

> TempCy i : = Pos i t i onHeads . Cy i i nder 

> TempHead := Posit i onHeads. Head 

> TempSector := Posit i onHeads. Sec tor 

> I F < CommandType = Mr i te > 

> THEH Get_HriteJData< Response > 

> ELSE flck_Read 

> Load-Cache 

> Seek< TempCy i, TempHead, TempSector > 

> END 

# >>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> > 
.LSTOFF 
.FIN 

.DO interna! 
.LSTON 
. Page 
FiN 

OverLap : 

Ca i I SrchJCache 
Jr Nz f OvrLapSeek 

Tm BlkStat,*CachHdChg ; check for a head change 
Jr Z,Gvr_Ld_Sctr 

Xor Head^OI ; complement the head value 

Push ! rO ; save SrchJCache resu I t 

Ld !rE,Head 

Ld !rO,#.HIBVTE. SslectHead 

Ld !rl",#.LOWBVTE. SefectHead 

Call BankJCail 

Ld !rO,*.HIBVTE. LoadJCache 

Ld !r1,*.L0WBVTE. Load-Cache 

Call BankJCail ; update the cache 

Pop !r0 ; retrieve srch_cache result 

Ovr_LdJSctr: find ?rO,*$1F ;mask off all but sector info 

Ld Sector, !rG 
Jr OvrLpJEnd 

OvrLapSeek: Ld !rO,*.HIBVTE. CnvrtLogicai 
Ld !r1,«.LDMBVTE. CnvrtLogicai 
Call BankJCail 

Ld ir4,*4 ;Retry := 4 

OvrLpJLp: Clr !r8 ;no wait 

Ld ?rO,#.HIBVTE. PosHeads 

Ld !r1,*.LGI4BVTE. PosHeads 

Call BankJCail 

Jr Nz,GurLp_2 

Tm ExcptJStatus,*Recovery 



OurLp_1 



OvrLp_2: 



Jr Z,OMrLp_i 

D j nz ! r4 , OvrLpJLp 

Clr IrQ ;byte 

Ld !M,*StatJSrvo 

Cal i SetStatus 

Cal I Abort 

Ld irO,«.HlBYTE. Ext_Push 

Ld !rO,*.LGWBVTE. Ext_Push 

Call BankJCa II 

Ld !rO.#.HIBYTE. LoadJCache 

Ld !r1,*.LQWBYTE. LoadJCache 

Call BankJCa 1 1 ; update the cache 

Ld !rO,#.HIBVTE. LoadJLogical 

Ld »r1,*.L0WBYTE. LoadJLogical 

Call BankJCa! i 

Call SrchJCache ;make certain block is in cache 

Jr Z,0urLp_^_1 

Call Abort 



0vrLpjS_1 



Clr 


Cache- Index 




Ld 


«rO,*.HIBYTE. 


ExtJPop 


Ld 


!r1,«.L0WBYTE 


ExtJPop 


Cali 


Bank_Ca I 1 




Ld 


!rO,*.HIBYTE. 


Seek 


Ld 


!rl,*.LQUBYTE 


Seek 


Call 


BankJCa II 





GvrLp JEnd : 



Ret 



.LSTOFF 

.00 External 
.L3T0H 
. Page 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

> Procedure: Seek 



This procedure accepts cylinder, head, and sector values 
and then calls position heads. 



Inputs: 



Cylinder: WORD { ! !rC > 
Head : BYTE { IrE \ 
Sector : BVTE { irF } 



Outputs: { none > 

Global Uaribles Changed: 

Cylinder, Head, Sector 

Algorithm: 

BEGIN 
i := 4 
WHILE < i > ) AND N0T< Posi tionHeads< Wait, 

DmtJSeek, Cylinder, Head, Sector > DO 

i := !■ -i 



> 


IF ( i = > 


> 


THEN fibort 


> 


ELSE 


> 


G 1 oba 1 Cy ! i nder : = Cyi i nder 


J. 


Global Head : = Head 


> 


Global Sec tor := Sector 



Sector-Count := Sec tor Count + 1 
DiskS tat. Parked := False 



END 



; >>>>>>>>>>>>; 


r >>>>>>>>>>>>>>>>> > 




.LSTOFF 






.FIN 






.DO 


Internal 




.LSTON 






.Paqe 






.FIN 




Seek: 








Ld 


!r1,*2 


Seek_Lp: 


Push 


irl ;save counter 




Ld 


lr8,#Mait 




Ld 


irJ,*Dmt_Seek 




Call 


PosHeads 




Pop 


\r] ;get counter back 




Jr 


Nz,Seek_End 




Push 


\r\ j save counter 




Ld 


!r2,*.HIBVTE. 20 ;wai 




Ld 


«r3.*.L0WBVTE. 20 




Call 


MsMait 




Pop 


!r1 ;get counter back 




Djnz 


\r\_, Seek_Lp 




Ld 


!rG,*G ;byte 




Ld 


!r1,*StatJSrvo 




Call 


SetStatus 




Call 


flbort 


Seek_End : 


Or 


D i skStatus , *0n_Track 




Ld 


Cyl inder, IrC 




Ld 


Cyl inder+1, !rD 




Ld 


Sector, IrF 




Incw 


SeekCount 




find 


D 1 skStat, *$FF-Parked 




Jp 


Bank_Ret 




.LSTOFF 






.DO 


External 




.LSTON 





. Page 



:>>>>>>>>>>>>>>>>}>}>>>>> 



Function: PosHeads { Position Heads } 

This function is responsible for postioning the heads of 

the drive. There ore two luays of positioning the heads via this 

routine: 1) Specify a logical block number < where all the 



USER accessabie blocks are numbered from to n-1 > or 2> 
by specifying the Cylinder, and Head number of any track 
on the disk surface. 

The may that Pos i t i onHeads interprets the block number is 
controlled by the input parameter Logical < i .e., IF Logical 
THEN BlockNumber is a Logical BlockNumber ELSE BlockNumber 
is Cy I i nder and Head > . 

The Spare Table is searched ONLV if Logical is true, this is 
consistent with allowing a diagnostic program to get to any 
spot on the disk independent of the data stored there. 



inputs: 

Wait 
Parent 
Cyl inder 
Head 
Sector 



BOOLEAN { !r8/bit 6 
BVTE { !rB } 
WORD { !!rC > 
BVTE { !rE > 
BVTE { IrF } 



> Outputs: 

> Pos i t i onHeads : BOOLEAN { Zero Flag; i.e., Zero is True if 

> Pos i t i onHeads is True > 

> Global Uariabies (Changed: 

> Cyl i rider, Head, Sector, Cur_Cyl 
> 

> Local Uariabies: 

> Seek, Posit ionDone : BOOLERN { !r4, !r-3 > 

> Cyl /Magnitude : WORD { < !rC, IrD ). < ir-5, !r6 } 

> Head, Sector, { [rE, !rF > 

> PosRetry, SioRetry, { !r7, !rR > 

> Direction : BVTE { !rQ } 
> 

> Rigor ithm: 
> 

> BEGIN 

> Se tDeadManT i mer C Pos i t i onHeads , Par en t > 

> Se!ectHead< Head > 

> Seek := CalcMagnitudeBirectiorK Cyl, Magnitude, Direction > 

> IF < Global Head <> Head > AND DiskStatus. Write THEN Seek := True 

> GiohaiHead := Head 

> Global Sec tor := Sector 

> PosRetry := 2 

> REPEAT ~ 

> IF Seek AND ServoGkC Reca I cNaqAndD i r { Boolean returned \n IrO } 

> THEN 
IF RecalcNagAndDir THEN Seek := Ca I cMan i t udeDi recti on < Cyl 

Nagn i tude , D i r ec t i on > 
SioRetry := 2 
WHILE ( SioRetry > ) AND 

NOT < SeruorS tore < RccessUar+D i rec t i on+ 

Nagn i tude t 1 1, Magnitude! 2 ]. 
AutoOffset, > DO" 
I F Recovery 
THEN 

ResetSeruo 

SioRetry := SioRetry - 1 
ELSE 

SioRetry := 
IF Wait AND < SioRetry > > 
THEN WHILE N0T< SeryoReady ) DO BEGIN END 
Pos it ionDone := NQTC ServoError ) 
PosRetry := PosRetry - 1 ■ 



;> UNTIL NOT< Recovery > OR Posit ionDone OR < PosRetry = > 

; > CI earDeadManT i mer 

; > IF Pos j t i onDone THEN CurJCy 1 : = Loea I Cy I i nder 

;> Pos i t i onHeads := Posit ionDone 

; > END 

;> 

.LSTOFF 

.FIN 

.DO internal 

.LSTON 

.Paqe 

.FIN 



PosHeads : 



Clc_NagDir: 



P_Ld_JSelHead: 
P_Ld_Retry: 

PosHds_Rpt : 



PosHds_Wh He: 



PosHds_4: 



Call 

Ld 
Call 

Call 

Cp 
Jr 
Tm 
Jr 
Ld 

Call 

Ld 

Ld 

Or 

Jr 

Call 

Jr 

Tm 

Jr 

Call 

Ld 

Or 

Or 

Ld 

Ld 

Ld 
Call 
Jr 

Tib 
Jr 

Call 
Call 
Cal I 
Djnz 

Call 
Tm 
Jr 
Djnz 



Ex t-Push : save ca 1 1 ers var i ab I es 



!rQ, «Dmt_PosHeads 
Set_Dmt 



;set Dead han Timer 
; get re I at i ve pos i t i on 
IF Global Head. <> Head.. 



CaicllagDir 

Head, IrE 

Z,P_Ld_fietry 

Disk3tat,*WrjQp 

Z,P_Ld_SeiHead 

!r4,*1 

SeiectHead 

Sector, !rF 

!r?,*2 ; Retry := 2 

!r4,!r4 ;test for Seek On 

Z,PosHds_4 ;if no seek then get out 

ServoQk ;test if Seruo is in a reasonable state 

Z,PosHds_3 ;if not ok then retry 

DiskStatus,*On_Track ; check for recalc of magnitude and direction 

Nz,PosHds_Hh»le 

CaicNagDir 

! r-Oj, Seek_Type 

?r0, ?r9 ; Pius Direction 

IrOj, Ir5 ; Plus Ns Magnitude 

! r 1 f ! r6 ; Ls Magn i tude 

!r2,*0ff_fluto 

!r3,*S_Rate_57_6 

ServoCmnd 

Nz,PosHds_4 

Excpt_£tatus,*Recovery ; IF recovery 
Z.PosHdsJS 

ResetServo 
UpDate_Hdr 
CalcMaqDir 
!rfi,PosHdsJ4hiie 



LoadS tatus 
! rO , *ServoErr 
Z . PosHds_3 
!r?,PosHds_Rpt 



; samp i e ServoError 

; i f servo error then retry 



Jr 



PosHds_J3 



PosHds. 



PosHds J5: 



PosHdsJD: 



SelectHead: 



Sei_HeadG: 
SelHd_End: 



Tm 
Jr 
Tm 
Jr 

Call 
Call 
Tm 
Jr 

Ld 
Ld 

Push 

Call 

Pop 

Tern 

Ret 

Or 
Jr 
Or 
Jr 

find 
Ld 

Jp 



;!F Wait AND NOT< ServoRdy > 

; THEM loop unti I timeout OR ServoRdy 



!r8,*Wait 
Z } PosHds J5 
! rO, #Ser uoRdy 
Z,PosHds_4 

Cir_Dmt 

LoadS tat us ; sample ServoError 

!rO,*ServoErr ; check if position done 

Nz,PosHds_6 

CurJCyl, !rC 
CurJCyl+1, IrD 

!r0 ;save status 

ExtJPop ;get caller's variables back 

IrQ 

! rO , *ServoErr ; return Z = true if servo error 



irE, IrE ; test for HeadO or Headt 
Z,Sei_HeadO 



Port3,HsQ 
SelHd_End 

Ports, *$FF-HsG 
Head, IrE 

Bank_Ret 



; select head 1 
; select head 



.LSTOFF 

.DO External 
.LSTON 
. Page 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

5- 

> Function: CalcMagBir { Calculate Magnitude and Direction } 

> This function takes the current cylinder number < from the 

> conversion of the logical block > and generates a magnitude 

> and direction from the the position that the heads are 

> currently at < the servo needs to know a RELflTlUE distance, 

> not an absolute distance >. 



Inputs: 



Local Cylinder : WORD { !rC, !rD } 



Outputs: 

CalchagDir : BOOLEAN { Ir4 > 
Magnitude : WORD { !r5, !r& > 
Direction : BYTE { !r9 > 

Local variables : 

Temp : BOOLEAN { > 
GiobaiPTR : PTR { ir2, lr3 > 

Algor ithm: 

BEGIN 
I F Loca ICyl i nder <> G I oba I Cy I i nder- 
THEN 

I F Loca I Cy I i nder > G ! oba I Cy 1 i nd&r- 



> THEN 

> Direction := Positive 

> Hagn i tude : = Loca i Cy I i nder - G I oba I Cy i i nder 

> ELSE 

> Direction := Negative 

> Magnitude := OlobalCyl inder - LocaiCyi inder 

> Temp := True 

> ELSE 

> Temp := False 

> CalcMagDir := Temp 

> END 

>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
.LSTOFF 
.FIN 

.DO Internal 
.LSTON 
. Page 
.F!N 

CaicllagDir: 

Push !rE ;save \rE 

Ld IrEj, IrD ;move cyi inder down one byte to use Sub3 

Ld IrD.lrC 

Clr !rC' 

Ld !r1,CurJCyl 

Ld !r2,CurJCyl+1 

Clr IrO 

Call Sub3 ;get Cylinder - CurrentCyi inder 

Ld ! rC , ! rD ; rep i ace cy I i nder Kmr- i ab I e 

Ld IrD, IrE 

Pop IrE ; rep I ace Head 

Clr !r4 ; assume no seek needed 

Jr Lt,C_NagDir_Else 

Clr !r5 ; assume track seek 

Clr IrS 

Ld !r9,*0 ;set direction negative 

Clr !r3 ; check for no seek condition 

Or IrS, Ir2 " 

Or !r3, !rt 

Or !r3, IrO 

•Jr Z,C_MagDir_Ret 

Jr SjGlbUCyl 

CJ1agDir_Else: Com !r2 ;2's complement sutraction result 

Com !rt 

Add !r2,#t 

fide ir1,*0 

Ld ! r 9 , #Hd JD i r_Frwd ; se t d i r ec t i on pos i t i ve 

SjBlblJCyi: Ld !r5, !rt ;load magnitude 

Ld !r&, Ir2 

Ld !r4,»01 ;set Seek 

CJIagD i r _Re t : Jp Bank_Re t 



.LSTOFF 

.DO External 

.LSTGN 

.Page 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: ServoOk 
> 

> This f unc t i on is respons i h f e for de term i n i ng i f the 

> servo is in a reasonable state to perform commands. In 

> other words i f ServoReady and NQT< ServoError > then 

> the servo is heal thy t wealthy and wise. If, on the other 

> hand, ServoError is active then the state of ServoReady 

> determines the type of action to perform to try to get 

> the servo back to a nice state: 
> 

> ServoError and ServoReady: Read Status 

> ServorError trnd Not< ServoReady ): Data Recai 
> 

> Inputs: { none } 

> Outputs: 

> ServOk: BQOLERN { Zero Flag, True if NOK ServoOk ) } 

> RecaicMagDir: BVTE { !r0 } 



Local Variables: 
Retry 
SioRetry 
Done 



BVTE { !rF > 
BVTE { Ir3 > 
BOOLERH { } 



> Control I erStatusPTR : PTR { i IrC } 

> Algorithm: 

BEGIN 

> RecalcMagDir := False 

> !F Recovery RHD ServoError 

> THEN 

> Retry := 4 

> WHILE < Retry > > RND ServoError DO 

> IF ServoReady 

> THEM ServoS t a tus< ReadStatus, x 

> x, Norma I ServoS tatus > 

> ELSE ServoCmnd< Da taReca I, x, X, x > 

> Retry := Retry - 1 

> IF N0T< On_Track > THEN RecalcMagDir := True 

> ServoOk := N0T< ServoError > 

> END 
> 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

.LSTOFF 

.FIN 

.DO internal 

.LSTON 

. Paqe 

.FIN 



ServoOk : 



Push IrS 

Push IrC ;save registers 

Push ! r-D 

Ld !rC,*.HIBYTE. Status-Port 

Ld !rD,*.LGUBYTE. Status-Port 



Tm Excp tJS ta tus , **Reco very 

Jr Z,SJOk_End 

Lde !rO,§!!rC 

Tm ! rO , *ServoErr 

Jr 2,S_JOk_End 



Ld !rF,#2 
>>>>>>>>>>>>>>>>>>>>>>>>>> 



; IF Recovery 
RHD ServoError 



; Retry := 2 



Or 
Jr 



!rF, !rF 
Z,SjOk_End 



:>>>>>>>>>>>>>>>>>>>>>>>>>> 



;THEN check for retry > 



SJOkJLpI 



Lde !rO,SHrC ; check for servo error 

Tm ! rO , *Ser voErr 

dp Z,S_J0k_End 

Tia !rO,*ServoRdu 

Jr Z,S_jOk_£ise " 

Ld !rO,*ReadStatus ;Load servo command buffer 

C!r \r{ 

C!r !r2 

Ld !r3,*S_Norm_jStatus + S_BateJ57_6 

Call ServoStatus : IF NOTC ServoStoreC . . ) 



S JDk -Dec 1 : 



Djnz 
Jr 



!rF,S_JDk_Lp1 
S-OkJEnd 



SJOkJEIse: Ld !rO,*DataRecai 

Cal i Restore 

Jr S J0k_Dec 1 

S JDkJLSpDa te : Ld ! r 1 1 #Dm t-ServoOk 

Co! I ReadHdr 

Jr Z,S_JDkJSt_Rst 

Cal i UpDate_Cur_Cy ! 

Jr SJDk-Decl 



S_JGk_JSt_Rst: Call ResetSeruo 

Jr S_Ok_Dec 1 

S _Dk_End : Lde ! rO , @ ! ! rC j samp I e ServoError 

Tern !rO,*ServoErr ; return z = true if servo error 

Pop !rD ; res tore registers 

Pop !rC 

Pop !r3 

Jp Bank_Ret 

.LSTOFF 



